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A  LEAST  SQUARE  ATTITUDE  SOLUTION 


ABSTRACT 


A  method  of  determining  the  orientation  of  the  axis  of  a  missile 
in  flight  is  presented.  Several  solutions  to  this  problem  have  evolved 
for  the  case  of  two  stations  where  there  is  no  overde termination  of 
the  parameters.  If  it  is  desirable  to  use  data  from  more  than  two  sta¬ 
tions  there  is  an  overdetermination  of  the  orientation  of  the  missile 
axis  and  some  adjustment  procedure  must  be  used.  The  solution  pre¬ 
sented  herein  is  a  least  square  procedure  developed  to  solve  this 
problem. 


3 


INTRODUCTION 


Several  procedures  have  been  developed  for  determining  the  orien¬ 
tation  of  the  axis  of  a  missile  in  flight.  All  of  the  procedures 
examined  thus  far  have  made  use  of  the  data  from  only  two  stations, 
thus  there  is  no  over determinate  on  of  the  parameters  involved. 

It  frequently  occurs  that  more  than  two  stations  observe  the  flight 
of  the  missile;  consequently,  the  data  obtained  from  the  additional 
stations  are  of  no  use.  If  more  than  two  stations  are  available,  it 
would  be  possible  to  use  one  of  the  above  mentioned  procedures  for  each 
combination  of  two  stations.  The  averages  of  the  results  of  each  com¬ 
bination  could  then  be  taken  as  the  final  values.  This  procedure 
greatly  increases  the  computing  time  and  the  improvement  in  the  final 
data  would  not  justify  this  increase. 

It  becomes  apparent  that  some  adjustment  procedure  should  be  applied 
in  order  that  the  additional  data  may  be  utilized  in  case  more  than  two 
s-tations  are  available.  The  solution  presented  in  this  paper  is  based 
upon  the  formulation  of  the  problem  according  to  the  principle  of  least 
squares . 

The  missiles  fired  on  large  ranges  are  observed  by  more  than  two 
cameras  and  the  least  square  procedure  may  be  used.  In  this  case,  how¬ 
ever,  the  cameras  have  a  narrow  field  of  view  and  the  assumption  that 
the  optic  axis  of  the  camera  coincides  with  the  line  of  sight  to  the 
missile  from  the  camera  will  be  valid.  This  assumption  will  be  made  in 
the  following  derivations.  It  has  been  shown  that  the  error  committed 
in  making  this  assumption  is  negligible. 2 

The  missiles  fired  on  small  ranges  are,  in  general,  observed  by 
only  two,  wide  angle,  fixed  cameras.  In  this  case  the  least  square 
procedure  is  not  aprlicable  because  there  is  no  overde termination  and 
the  above  assumption  is  not  valid  because  of  the  wide  field  of  view. 


See  Bibliography,  page  lli. 

2 

Attitude  and  Yaw  Reductions  of  Projectiles  in  TVee  Flight,  BKL 
Report  No.  77k,  G.  R.  Trimble,  Jr.,  1951,  pp.  M-U3. 
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FIGURE  1 
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PRELIMINARY  REMARKS 


Before  proceeding  to  the  least  square  solution  it  is  necessary  to 
introduce  several  other  concepts,  the  first  of  ■which  is  the  coordinate 
system  used.  Any  rectangular  coordinate  system  will  suffice,  however, 
for  the  sake  of  giving  some  physical  meaning  to  the  concepts  involved 
let  the  0-XYZ  system  be  defined  a^  follows  (See  Figure  i): 

(a)  The  origin,  0,  is  a  point  on  the  range  whose  geodetic  coordinates 
are  known; 

(b)  The  XY-plane  is  tangent  to  the  earth  at  the  origin; 

(c)  The  X-axis  is  positive  in  the  direction  of  the  line  of  fire; 

(d)  The  Y-axis  is  perpendicular  to  the  X-axis  positive  to  the  right; 

(e)  The  Z-axis  is  perpendicular  to  the  XY-plane  positive  upward. 

Let£,  9,  and  E  be  unit  vectors  which  lie  along  the  X,  Y,  and  Z 
axes  respectively. 

*th 

Point  CL  is  the  nodal  point  of  the  lens  of  the  1  camera,  line  CLX' 

is  parallel  to  the  X-axis,  line  0!M  is  the  line  of  sight  to  some  point  on 
the  missile  and  point  CL  is  a  point  between  CL  and  M  such  that  distance 
CLCL  is  unity. 

Vector  ^  .  is  a  unit  vector  along  the  line  of  sight  to  the  missile. 

Vector  ^  is  a  unit  vector  parallel  to  the  XY-plane,  perpendicular 

to  £  i  and  directed  to  the  right  of  4 

Vector  £  ^  is  a  unit  vector  perpendicular  to  ^  and  7j  directed 
according  to  the  vector  right-hand  thread  rule. 

The  elevation  angle,  £.^,  is  the  angle  between  the  line  of  sight 
and  the  XY-plane  measured  upward  from  the  XY-plane. 

The  azimuth  angle,  OE^,  is  the  angle  between  the  projection  of  the 

line  of  sight  upon  the  XY-plane  and  the  X-axis,  measured  positive  clock¬ 
wise  from  the  line  CLX'*  that  is,  from  the  X-axis. 

In  view  of  these  definitions  it  is  seen  that 
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J^i®(ccs  cosau)4+(cos  € ^  sinoCi)  ^  +  (sin  £  )  £ 

(1)  ]  sin  0^)4"  *(cos  a±)  7] 

£^mi ■  sin  €•  ^  cosa±)  4  -(sin  f  .  sin  OL  ±)  rj  +(cos  €  )  £ 


Let  in  be  a  unit  vector  which  lies  along  the  missile  axis  directed 
from  tail  to  nose. 

The  axiruth  of  the  missile  axis.  A,  is  the  angle  between  the  pro¬ 
jection  of  the  missile  axis  upon  the  XY-plane  and  the  X-axis,  measured 
positive  clockwise  from  the  X-axis  . 

The  elevation  of  the  missile  axis,  E,  is  the  angle  between  the 
missile  axis  and  the  XY-plane,  measured  upward  from  the  XY-plane. 

Hie  vector  m  may  be  expressed  in  terms  of  the  basis  vectors  4  > 

,  and  £  as  follows: 

(2)  m®(cos  E  cos  A)  4  +(cos  E  sin  A)  y  +(sin  E)  £ 

Vectors  Tj  ^  and  determine  a  plane,  commonly  referred  to  as  the 

"standard  coordinate"  plane,  which  is  parallel  to  the  plane  of  the  film. 
Distances  measured  on  the  standard  coordinate  plane  are  simply  a  con¬ 
stant  multiple  of  distances  on  the  film  plane.  Hereafter  we  shall  treat 
the  standard  coordinate  plane  as  though  it  were  the  film  plane  since 
this  scale  change  does  not  affect  what  follows. 

The  missile  image  lies  along  the  intersection  of  two  planesj  one 
pl^ne  is  the  plane  containing  the  missile  axis  and  the  line  of  sight 
to  the  missile,  the  other  plane  is  the  film  plane.  Let  m^  be  a  unit 

vector  which  lies  along  the  missile  image. 

The  angle  V^  is  the  angle  between  nu  and  £ ^  measured  positive 
clockwise  from  £  Vector  £ .  lies  along  the  intersection  of  the  ver¬ 
tical  plane  through  the  line  of  sight  with  the  film  plane.  This  inter¬ 
section  can  bs  determined  physically  by  having  fiducial  marks  on  the 
film.  It  is  then  possible  to  measure  the  angle  V^  directly. 

It  is  seen  that 

(3)  mi  .  7?  sin 

and 

(U  irn  .  §  ^  cos  Vi. 
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con- 


Define  the  vector  by 


n±  ■  (m  X£i)/  j  m  X§.J 

Then  n^  is  a  unit  vector  normal  to  the  plane  containing  m  and 
sequently  n^  is  perpendicular  to  rrn,  (n^,  £  are  thus  coplanar) 

Since  mr-  is  perpendicular  to  both  n^  and  ^  we  have 

rru  =  E  ^  I 

-  X  (m  X$i)/  |  mX  j 

=  [(£±  ‘  ^i)  m"(£i  'm)^iJ 
=  fm  - 

consequently,  from  equation  3  we  obtain 
sin  V±  =  j[m  -  (m'|i)(jiJ  -  >]  ±J/  j  m  x£±  j 

=  m  *\/  (m  '  4i)2 

and  finally 

(5)  sin  =  m  «  Y)  ./  sin  0^ 

where  8^  is  the  angle-  between  missile  axis  and  the  line  of  sight  to  the 
missile. 

Making  use  of  equations  1  and  2  equation  5  becomes 

(6) 


sin  V 


cos  E  sin  (A  -  cA 


cos  E  sin  cos  (A-OL)  +  sin  E  cos  +  jcos  E  sin  (A”0^* 

and  the  sign  of  cosjne  as  given  by  equation  U  may  be  used  with  the 
above  expression  to  completely  determine  and  the  quadrant  in  which 
it  lies. 
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Equation  6  is  convenient  for  computing  purposes  because  the  denom¬ 
inator  is  nothing  more  than  sin  0^  for  which  it  is  possible  to  determine 

a  lower  bound.  This  fact  is  very  important  when  the  procedure  is  pro¬ 
grammed  for  a  high  speed  automatic  computing  machine.  It  als^  gives  a 
numerical  means  of  determining  the  reliability  of  the  V-angle  itself. 

If  6  =0,  the  missile  axis  lies  along  the  line  of  sight  to  the  missile 
and  there  would  be  no  V-angle.  For  small  values  of  0,  the  missile  image 
would  be  greatly  foreshortened  and  the  measured  V-angle  would  not  be  very 
reliable.  An  estimateoof  the  smallest  value  of  8  for  which  the  V-angles 
are  measurable  is  8=20  .  However,  to  make  certain  that  this  bound  is 
never  reached  a  value  of  8=10  has  been  suggested  as  the  minimum. 

Mr.  W.  R„  Clancey  has  developed  a  formula  for  tan  V.  rather  than 

1  _  1 
sin  V±o  Since  most  of  the  high  speed  automatic  computing  machines  now 

in  operation  do  not  use  a  floating  decimal  system  i t  would  be  very  dif¬ 
ficult  to  deal  with  the  tangent  formula  on  these  machines  because  of 
the  large  valves  the  tangent  may  take.  For  this  reason  the  sine  formula 
given  above  is  used. 


A  Method  for  Calculating  Rocket  Attitude  Data,  W.  R.  Clancy, 
BKL  Technical  Note  No.  August  1950. 
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THE  LEAST  SQUARE  ATTITUDE  SOLUTION 


The  theory  of  least  squares  requires  that 


(7) 


n 

s  S.  (v  -V'): 

• i=l  11 


1=1 


r 

sin  ^ 

cos  E  sin  (A- CX.) 

Lnl 

cos  E  sin  cos(A- oL  )+sin  E  cos  ^+|cos  E  sin(A-<^j^ 

f 

be  minimized,  where  V!  is  the  observed  V-angle  and  P.  is  a  weighting 
factor.  Differentiating  S  with  respect  to  A  and  E  and  setting  the  deri¬ 
vatives  equal  to  zero  we  obtain  normal  equations  which  are  non-linear. 
These  equations  are  very  hard,  if  not  impossible,  to  solve.  We  make 
use  of  a  method  described  by  K.  Levenberg  which  reduces  the  normal 
equations  to  a  system  of  linear  equations.  This  system  of  linear  equa¬ 
tions  can  be  solved  iteratively  and  Levenberg  has  shown  that  the  iterative 
process  converges  to  the  "true"  solution.  Levenberg  calls  the  method 
"Damped  Least  Squares". 


Replace  V. 
tion  AQ,  Eq,  to 


by  a  Taylor  series  expansion  about  an  approximate  solu- 
obtain 


Ti  Cl,i(E"V  +  C2,i(A-V 


where 


V?  =  sin”^ 


cos  Eq  sin  (Ap-O^) 


Jjjcos  EpSin  ^cosCAq-ct.  )  +sin  Eq  cos  +£cos  E0sin  (Aq-o^)! 


-cos  £^sin(Ap-  £X\  ) 


J-cos  EpSin  e^cos(A0“  ctf^)+sin  EQ  cos^^J  ^  +  £cos  E^sin(A0- 


K.-  Levenberg,  A  Method  for  the  Solution  of  Certain  Non-Linear  Problems 
in  Least  Squares,  Quarterly  of  Applied  Mathematics,  Vol.  2,  No.  II, 
1914;,  pp.  16U-168. 
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%i 


-cos^E^sine^  +sin  EQ  cos  E^  cos  cos  (Aq=  on) 

jj-cos  E^sin  C^cos  (Aq-  Q(^)+  sin  cos  +  [cos  Eq  sin  (A0-  ol±)J 


and 


— 1 

0> 

< 

H* 

_ 1 

G  « 

aV 

[3E  J 

fat  A.)  9 

'  i 0 9  0  1 

o>A  _ 

(*0*  V 


Denote  by  S  the  expression  obtained  by  replacing  TTj_  in  equation  7 
by  V  .  The  procedure  Levenberg  describes  requires  the  minimization  of 
the  function 

(8)  F  -  +  (4A)2  +  (AE)2 


where 

A  A  — ■  As=Aq  g  A  E  *  Et-Eq 

and  »  is  a  constant  to  be  determined  later »  It  is  seen  from  equation 
8  that  not  only  are  the  squares  of  the  residuals  minimized  but  also 
the  squares  of  the  corrections  which  must  be  added  to  the  approximate 
solution  are  minimized. 


Differentiating  F  with  respect  to  A  and  E  and  setting  the  deri¬ 
vatives  equal  to  zero  we  obtain  the  linear  1 normal  equations 

(9)  v 

n  n  n 

1 


r 


AE 


+AA  \f„g_  .C.  .  «  \p.C-  .On  -  V?) 

/  il,i  2,1  /  i  l,iv  i  V 


1=1 


n 


i=l 


n 


i=l 


^PiCl,iC2,i 

i=l 


+AA 


IP.C,  .  +i 
I  i  2,i  os 


i-1 


n 


V°) 


i-1 


It  is  a  simple  matter  to  solve  this  system  of  equations  forAE  and  A  A. 
The  improved  values  are  then  'given  by 

(10)  A  =  AQ  +AA,  E  *  EQ  +  A.E, 
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If  the  values  of  A  and  E  obtained  in  this  manner  are  not  sufficently 
accurate  the  procedure  may  be  repeated  using  these  improved  values  as 
the  approximations.  This  process  may  be  repeated  as  many  times  as  required 
to  insure  accuracy  commensurate  with  the  data  being  analyzed. 

Levenberg  has  shown  that  the  best  value  of  »  is  given  by 


«- 1/2  k  (q  -  vpi 

(f 

£  ci,i(Ti  -  Ti5 

2  ♦ 

~n 

^p7e.  .(V!  -V?) 

Cl  z*1  1  1 

\] 

«  / 

t  1=1  J 

i=l 

u 

Trial  computations  indicate  a  value  of  l/«*  =  lj.5  for  the  first  iteration 
and  l/«  =  0.1  for  the  second  iteration  for  three  station  reductions  of 
Muroc  bomb  drops  in  which  the  final  values  of  A  and  E  obtained  on  one 
frame  of  data  were  used  as  the  approximate  solution  for  the  following 
frame  of  data,  and  the  weighting  factors,  P-j_  ,  were  taken  as  unity. 
Experience  should  improve  these  estimates.  Two  iterations  are  suffi¬ 
cient  to  obtain  an  accuracy  of  0  .1.  k 
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Aberdeen  Proving  Ground,  Ballistic  Research  Labs.,  1.  Projectiles  -  Trajectory 
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A  method  of  determining  the  orientation  of  the  axis  of 
a  missile  in  flight  is  presented.  Several  solutions  to 
this  problem  have  evolved  for  the  case  of  two  stations 
where  there  Is  no  overdeterminationof  the  parameters. 

If  It  is  desirable  to  use  data  from  more. than  two  sta¬ 
tions  there  Is  an  overdetermination  of  the  orientation 
of  the  missile  axis  and  some  adjustment  procedure 
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must  be  used.  The  solution  presented  herein  is  a  least  square  procedure  developed 
to  solve  this  problem. 


